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a final estimate of the at least one submersible vehicle's position with a range corrector that 
utilizes the linear Kalman filter position estimate at time (n), x&. a sea borne position marker, 
marker 06 ^ ""^ 21 ° nC submersible vehicle to the sea borne position 

REMARKS 

Prior to examination, Applicants respectfully submit this Supplemental Preliminary - 
Amendment amending the above referenced Provisional Application converted to a Non- 
Provisional Application on May 9, 2002. Applicants respectfully submit the substitute 
specification attached hereto, amending the format of the current specification to conform to US 
Practice. Due to the extensive deletions and formatting changes, Applicants believe that a 
substitute specification is the most efficient way to amend the existing specification to conform 
with US Practice. Applicants also respectfully submit amended claims 1, 7 and 16 for the above 
referenced application. Support for these amended claims is contained in the existing 
specification. Favorable action on the merits of the application is respectfully requested. 

Kindly charge necessary fees or credit any overpayment to Deposit Account No. 50- 

0281. 

Respectfullvsubmitted, 




Chester L, 
Registration 



John Karasek 

Associate Counsel (IP) 

U.S. Naval Research Laboratory 

4555 Overlook Ave, SW 

Washington, DC 20375 

(202) 404-1557 

May 30, 2002 
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Marked-up Claims 

1. (AMENDED) A system for the accurate determination of the position of an 

underwater vehicle comprising: 

a sea borne position marker having a known position; 

at least one underwater vehicle acoustically coupled to the single position marker; 

a system observer comprising a state updater for predicting the underwater vehicle's 
position, [Pp(n)] 3^, based on a past estimate of the underwater vehicle's position, [Pe(n-l)] 3^ 
I and an estimate of the underwater vehicle's velocity over the sea bottom, and a maximum 
likelihood estimator, to estimate the underwater vehicle's position (MLE(n)), utilizing measured 
ocean depth at the underwater vehicle's position, bathymetry data and the underwater vehicle's 
predicted position based on a past estimate of the underwater vehicle's position and an estimate 
of the underwater vehicle' velocity over the sea bottom, [Pp(n)] 2fe in a single point position 
match; 

an extended Kalman filter that takes state updater' s estimate of the underwater vehicle's 
position, [Pp(n)] 2^, and the maximum likelihood estimator's estimate of the underwater 
vehicle's position, MLE(n), and computes a linear Kalman filter position estimate at time (n) 
[KPAT^XainJand 

a range corrector that utilizes the linear Kalman filter position estimate at time (n), 
[KPAT(n)] 2ejn_, a sea borne position marker, and a measured slant range from the at least one 
submersible vehicle to the sea borne position marker and computes a final estimate of the at least 
one submersible vehicle's position. 

7. (AMENDED) The system of claim 2 wherein said means for predicting the at 

least one underwater vehicle's position, based on a past estimate of the underwater vehicle's 
position and an estimate of the underwater vehicle's velocity over the sea bottom comprises a 
state velocity updater . 



16. (AMENDED) A computer for the analytic determination of the position of at 

least one underwater vehicle acoustically coupled to a position marker having a known position 
using bathymetry data, positioning data, the underwater vehicle's velocity over the sea bottom, 
and a slant range from the position marker comprising: 

a computer for computing 



4 



PAGE 6/36 * RCVD AT 4/27/2004 11 :29:37 AM [Eastern Daylight Time] * SVR:USPTO-EFXRF-1/2 * DNIS: 8729306 * CSID:202 404 7380 * DURATION (mm-ss): 13-02 



04/27/04 TUE 11:30 FAX 202 404 7380 



NRL CODE 1008.2 PATENTS 



[g]007 



(d) 



(e) 



a prediction of the underwater vehicle's nosirinn rcw«vi v u ^ 
estimate of the underwater vehicle' ^^^^1 ' ^ ^ 
of the underwater vehicle's velocity XsZtoZ^ TLt 

Z™Z±Vt U ^™V ^Y* POSiti ° n measured 
ocean depth at the underwater vehicle's position, bathymetry data Mid the 

underwater vdncto's predicted position based on a past^sS^ o£rfe 

underwater vehicle's position and an estimate of Junderw^r vehicle' 

ZSZZSSZ er^ (n)] * ^ 3 P-*- with a 

ffi a linear Kalman filler position estimate at time (n), [KPAIYDI r , usi™ ,h, 

state updated estimate of toe underwater vehicleVposSon t£fcZ »d 

Ke°S„a^ 
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BACKGROUND OF THE INVENTION 

1. Field of the Invention 

This invention pertains in general to a system and method for the accurate estimation of 
the position of and underwater vehicle and more particularly to a system and method for 
the estimation and tracking of an underwater vehicle's position using a combination of 
bathymetry data, and the underwater vehicles dynamics data in relation to a position 
marker. 

2. Description of the Prior Art 

Under water vehicles are in common use for surveying and locating objects in the ocean 
due to their relatively low operation cost. To be useful however, the position of an 
underwater vehicle must be known so that the data collected by the towed vehicle's 
sensors can be georectified. Due to ocean dynamics,. currents, waves, temperature 
fluctuation etc., acting on underwater vehicle's tether or on the vehicle itself a 
submerged vehicles position relative to the towing vehicle or some other georectified 
point is often difficult to determine. Since the ocean is opaque to high-frequency 
electromagnetic signals, the global positioning system (GPS) generally cannot be used for 
submerged vehicle positioning. 

Current methods for determining the position of a underwater vehicle include the lay- 
back model (See, Figure I), the long base line (LBL) model (See Figure 2), the short 
base bne(SBL) model (See Figure 3), the inverted SBL system and the Localization 
System (LOST)(See Figure 4). These system are generally configured to manage the 
position of a tethered or towed vehicle and are ill equipped for an remote or untethered 
underwater vehicle. 

With the lay-back model method the underwater vehicle is tethered and is assumed to be 
directly behind the towing vehicle and the lay-back (distance from the towing vehicle) is 
assumed to be a fixed multiple of the tow vehicle's depth. Alternatively, the amount of 
cable paid out 1S assumed to be the slant range to the tow vehicle. The inverted SLB 
method does not take into account the cable's cantilever. Neither the lay-back the LBL 
nor the SLB methods take in account the effects of local current on the cables' shape and 
position. The accuracy of these methods will, in general suffer as a function of time and 
therefore not support precise positioning of the towed vehicle. 

The LBL method uses a series of acoustic transponders to localize the tow- vehicle by 
measuring the time delays between the tow -vehicle and the transponders. These 
J^ToS?"^ b ! b ° tt0m mounted or localized on the surface, as shown in U.S. Patent 
3,1 jy,J4i. While these systems are very accurate, their deployment is a time consuming 
and expensive operation. Furthermore the LBL method requires that the systems be 
redeployed to each operational area. 
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accurate but their reso],,«™!« „ compute position. These systems are fairly 

craft-an obvious economic duStSSb^T t ° W " Veh,cle ' ^""""S » 

this system is a problem for^d^ i£ fZS? 'jSL^T ^r^/^ 05 
cannot be readily used to appSo^other Z ^wfd s^I ^ 

ate underwater veSc,e^Sn SiridS^SSf ^ *,~ mm 

does not change This featim. limit, i unaerwater vehicles position along track 

duecfy be^ iSSSS SST '** " " ~ 

Summary 

performance and a conSSJSSS u matChin S modu ^ 

extended Kalman mtor s^sZ^r^ P ^ SQbsyStem - ^ constrained 

^-auiittn uiier suosystem includes a steady state extpnH*»rf v^**,*- cn 
linear constraint module, and a state mwKrt™. -ru T ext f nded K alman filter, a non- 

location of the knowrZS Md ZlS^T?^' ^ Slant ran S e *» 

prediction of the i^^StoTS^.- e *™ te ° f the VCSSel ' s P osition «d a 

determination of £ posS o *T ^ A JnBthod forthe 

CD acoustical* StepS ° f 

having a known position- (2) Dredicti^nff f °, a 863 bome P osition 

based on a past i^^^S^^^T^T 

velocity over the sea bottom- f3) cSZfZo S , ,? P " ^ m estimate of its 

measured ocean d-A^S^toSSS,^ underwater vehicle's position utilizing 

underwater veMctTpi^ , S P ° SltIOn ' ^ymetry data and the 

estimate of the undJS^K^i^^^.^ (4) com P^ga 
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BRIEF DESCRIPTION OF THE DRAWINGS 
Figure 1 shows a cable lay back method of the prior art 

£ f WSal r g u aSeline (LBL) approach of the prior art 
F gure 3 shows a short base line (SBL) approach of the orior 
Figure 4 shows a localization system CLOST 7\ *Z I I t 

Figure 8 shows a block diagram of the LOST-2 system 

Hra ?n *" S * ^""/S™ 1 <**• «y»»n observer'subsystem 

figure 12 shows a block SaS of £. SES £ f ^ maKhi,,S mwiuk - 

prediction module <* the signal flow for the spatial based performance 

F,fure 15 shows a SS ^ SSS flow £ f f^ 7 Katom Slter - 
Bgure 16 shows a block diafam J£ ffi K £ ^SLSEST 

Detailed Description 

dead-reckoning, accusfe-b^land i^, ZT? "" d °" ! ? ,0d c ° mbiMS P"" 5 ° f 
system and apply ^t^T^h^ ^ positioning into a single integrated 

designed to two l^Z^t^Z? Z^""??™™''- ™° is 
Kataan filter. Prior to ascisZ'*. i ^ ? and the c01 «>rata«i extended 
of each s»bsys.eiTo^„sTow? v SSS " taef "^P" 0 " >* *e basic architecture 
systems are no, ^to^Z^rt^ZvT™ " Md ■* 

StomarS?ac„^ a a ,1X&^ ^ ^ 
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To the kno*n £ta Ss tafamSt slate and a measured slant range 

» generate a Li J^SSSSZ S^cK^ ^ ^ ^ 

ftaal estimate of state MdTSSn S °. f ** k " 0Wn P"*" Mm P u »» *« 
the position of me un^a^td « *" MM s,ate <° *««*• an «tima«e of 

frn^n^ 

» -at the position of the U^SSSd^ i^S^IFm"" 0 *'* 

of the slant range 560 of the underwater v *h;^~ * l «- nni que exist tor the measurement 
marker must be easily id^S^^S? 1 *■ P T° n marker 52 °- ^ Potion 
bathymetry data SSO f^S^^J^^^/ 0 ^ »** °* 

LOST-2 also uses the und^wTter S L?! i > J undBrww a" ve ^le localization, 
vehicle dynamic iiSSrS^^^^S^ 35 ^ UnderWater 

In this example ^^^^S^i^^^^T P ° Sition - 
by the use of 2 dimensional £S£S£ES^ 

employs a 2 (iirnensional model adrirt«^ . anen y> me LOST-2 system 
the underwater vehicle's c^ss t^^£^S^^^ *** ^ 

position data when both the longitudal S^ZS^S^^J^^ T™* 
vehicle varv Via the> n f o JtL , , 25 016 cross track of the underwater 

and a smg^po^on nZ£ ^stT™^ 8 *** ^ CIOSS *W 

several uLhUd «* *■* the location of" 

to the underwater vehicle's de^oymem (2) ^ S 530 ofT " ^ dUdng 0r 
through the use of a pressure sensor or with .„ i ^ : f * e vehicle 510 

the velocity of the vS^^S^StS^ rangin S <3) 

560 to the position rnark^ 5?0 , !• ^ Speed (4) ^ ^ slant range 

marker or on the ZZ^eZZl IkT^V™* °" ^ P osition 

point which is P-ferably^ at a known 

estunated geo-rectified position of the md^'^^- 2 ^ > ° UtpUt 18 *» 

Figure 6 shows the top view of an example embodiment a LOST ? .„ ♦ 

pro^ng the Position of 4 Mttthered Jderwat^SS^^^e 
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position marker 620 having a known position is acoustically coupled to untethered 
underwater vehicles 610, 610', 610", and 610'". Preferably Jh under^STeLk 

m^Ll20ThtH lth 3 r Pl . 6 tranSp ? nder WhiCh iS coupled ptition 

marker 620 which may be a floating buoy or located on the sea floor By acoustic 

known poult 670, is measured. For the area in which each of the underwater vehicles 
operates, there must exist bathymetry data preferably geo-rectified aXfTh^ " 
resolution. When operating multiple underwater vehicle's LOST 2 «qu£s a dLb 
measurement for each underwater vehicle 601 and the velocity of eTch ^the 
underwater vessel's including both course and speed. 

fadependently for each underwater vehicle LOST-2 predicts the underwater vehicle's 

system then computes an estimate of the underwater vehicle^ poSSed^e 

eSma^ Z T "f^Sf VehiCle ' S P ° Siti0n b2Sed « vehicle dy^ c rand thf 
LO?T ?1h ""^ VBhlCleS P ° Siti0n baS6d 0n ocean ^P* bathymei^ datl 
^ ? n com P utes a corrected estimate of the submersible vehicle^Dodtior that 
unhzing the estimate of the underwater vehicle's position and a me^dXt rLt 
from the underwater vehicle to the sea home position marker whose pSnTs Sown 
These steps are repeated for each underwater vehicle using bathymeur S and 
information relevant to that particular underwater vehicle dynamic 

2S£^^ TWs embodiment of 

acouS^^^^ on the sea floor 
shown in Figured ^ 

location of the position marker is geo-rectified. preierac-ly the 

Lns? ? It7 a 8 bl ° Ck diVma ° f me ^orithm employed by the LOST-2 system The 
LOST-2 system comprises two basic subsystems, the system observer 810 and mT' 

SEfil^J^ ?T m 711636 ^ ^ster^fo^otsix 

^^^^ b °sr ve moduies - d sub systems ~ - - 

The ^stem observer subsystem is composed of three modules: a state 

velocity update 850, terrain matching module 840, and means for generating a prediction 

steaTsta^t 6 ^?? ^f" ^ SUbSyStem 820 consists <* modules: a 
preSctSo filt6r 87 °* a n0n - Hnear Constraint moduie ««>. «* a state 
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SyMnaobMrvw 810 takes in all the available measurements and generates two position 
estimates one from Newtonian motion and the other based on the terrain in the area. As 
shown in Figure 8, system observer 810 integrates the high resolution bathymetry 811 
vessel s measured ocean depth 812, vessel's predicted state 13, the vessel's measured 
velocity 814, and the measured slant range and location of the known point 815 into the 
terrain based state estimate 841. The system outputs the terrain based state estimate 841 
a final predicted state 860 and the measured slant range and location of the known 
point. The system observer also computes a prediction of the performance of the terrain 
mapping system shown in Figure 8 as a spatial performance estimate 831. 

The constrained extended Kalman filter 820 takes the terrain based 
state estimate 841 a final predicted state 860, the measured slant range and location of 
the known point 815 and computes the final estimate of state 899 and a prediction of the 
system state at the next time step 898. ^uwi ui me 

The inputs the system requires are a detailed, high resolution 

bathymetric map in the operational area 811, a slant range to a known position 815 

ZSTTS? * e u underwater vehicle *s ««* 813. a measured or estimated velocity'814 
and the depth of the ocean at the position of the underwater vehicle 812. 

Referring again to the embodiment shown in Figure 5, the high resolution 
bathymetac map in the operational area is shown as 550, the slant range to a known 
position 560 is effective the range from underwater vehicle 510 to position marker 520 
an estimate of the underwater vehicle's state which is generated byVe LOS?5 system 
den th nfT } ' * or u estimated Cecity of the underwater vehicle 570 andSe 

depth of the ocean 590 at the position of underwater vehicle 510. These inputs are used 

SeooS of ° UtpUt ° f ^ moduleS to * enerate accSS 

the position of the underwater vessel 510. 

2K l Sh ° W u a blockdia .8 ram of ^ System Observer subsystem 910. As stated 
ear her, this subsystem's primary function is to generate all the predictions of theTtate 
fcatare required by the constrained extended Kalman filter. It ako prov "dL a SSL 
of performance based on the spatial distribution of the bathymetry. This sSsyS 
integrates the high resolution bathymetry, vessel's measured ocean depth vessel™ 

E25?J T£? vesser s measured velocity - ■ nd ** measured 

location of the known point into the terrain based state estimate. The subsystem's 
outputs are the terrain based state estimate, the final predicted state andS 
measured slant range and location of the known point. 

The first subsystem component is the state velocity update, whose signal 

flow diagram is shown in Figure 10. The state velocity update module 850 serves to 

provide an estimated location of the underwater body. It does this by combining the best 

SLlEX ^time* *" ^ ^ ^ "°**> « 
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The output of the state velocity update 840 is sent to the terrain matchine 

o^H f Sign , al fl ° W iS Sh ° Wn aS KgUre 1L ^ terTain matching module is the 
SaWv mS that SerVBS M * 6 inde P endent ^ observation. The observation is 
fhfn^H ^ y C ° mpann S the "*asured ocean depth 1 1 12 to the bathymetry 1 1 1 1 i n 

Tie ouS I***- ?? b * mea * s of amaximum likelihood esSmator 

The output of this module is the terrain based state estimate 1141, which is also the 
independent system observation. 

^SL n ¥f ,le - ° f ^ SyStem ° bSerVer iS * e Spatial ^ P^onnance 

prediction. The signal flow is contained in Figure 12 The suatial nprfn™,,^. ♦• 

Svtt^3T b Son t rtt of h r 4 1116 ~ 

STnvSr vehid? ^ reS ° IUtl ° n bathymetty 121 1 in the ™ of the 

T^ sy^em observer generates two separate estimates of the position of the underwater 
body. The first position estimate is generated in the velocity update This nQerWater 
position estimate is then used in conjunction with bathymetry to generate the 
terrain based position estimate. generate me 

ThfSLl? Sh .° W l a "?* ***** ° f me Signal floW of state ve l°«ty "P^te module 
The state velocity update module receives the vessel's predicted state Sing^ToTmT 
mformafon before the current time step 1013, and the vessel's measured velociS 10^14 
^d computes the vessel's final predicted state 1060. The vessel's fin^ preyed stl is 
^ underwater vehicle's position, * . based on a past estimate of the underwater 
La btttor Sltl0n ' ^ " CStimate ° f *° underwater chicle's velocity v„ over the 

The velocity update module serves as the dead-reckoning system and computes 

s^Thf H POSltl ° n ^ ^ VeSSd in 1116 ^ crossttackcooSe . 
S ?™hXh "7 measured f vel °«ty vector for the underwater vessel, and me 

° f pOS1 ? on , ° f ""^^ vesse * from the previous time step 

s^ss^^ssf^^ 4 processes ' one in each Tws * — 

SES? mSed ht r ition estimate is computed * *• me ^ d 

velocity, multiplied by time as appropriate, to the previous position estimate. 
The formulas used to compute each part of the estimate are: 



K ~ <ln-l+< (3.3) 
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given a« Won^a ^ « - — » 

position before the dm, „ m...., ? f»™rore, ls the best estimate of the 

estaate *^^^ , ^^S^,SS I W ' *" ■"— * 

•riple, oi = (xi w o) WhOT Z 9 ^ P°"> m this bathymetric data set is a 
northings) anS^s £Se^S P ° S " i< ? VKt0r '"""W 

this da« has been previou™ ^^^iT^cotl^^ 
underwater vehicle deployment. nowever " may be collected concurrently with the 

be formed using the same £ L ai ^ZJZT'T™*' W,or ' 0 "' = <*- can 

then themeasltS,? ^SaTSSi^ * "Z""** ( * **>■ 
reckoned position*. canT^St e i^*" 0 * "» "» ">« 

ES^a^iT^^ « used, 

the vatafof me^bservatioT^? ^ * dutnbuti °" «*"> unknown parameters 
esttaa* thTpar^ ttf^r 2 " the , Jateliho «' *">«io„ is the best 

The LF can be expressed as: 
L ( Qt i(«"n)=/«(ai-a _ I1 ) (3.5) 

™?v^ 6 ? ™ atCd P ° Sition °* bathymetry in the area f a i th. 
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The Terrain matching module employs the following relation: 

Afoky) = (a* - Q-fS-^ce, - a ~) (37) 
where a, (alpha i) refers to data points from the bathvmetrv «*r « f a i„ h , ^ • .u ^ 

teS t a 7? i s V l>,f ^ h iS P ° Sitive ^finite, the likelihood 
Junction in (3.7) is strictly non-negative with minimum 0 at ax = Th P m L , i 
fonhe covariance m atrix van K depend on te ^ » b ^~^ 

*" " y *»"• 3 8 — *" *• "—I v^=« in I. position for each of 





oi 


0 o 




0 






0 


o o2 



(3.8) 



comprises a steady state extcndJ^S^^^ 311 ^ Subs * stem 
1380, and a state predictor non ThHSli f ' anon - luiear constraint module 
nonlinear conSms toTare SL^^^f ^ * &ta,-n ffltor 1370 featoes 
poor nature of all moSS^ 
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SiSr sssr^ fiiter is shown * f ^ *** °* 

estimates into^^SJt^JSI^J 0 a11 ° f *■ "ate 

the terrain based state estimate ^"-J*™ subsystem takes as input 

• range and locJ^S^^^^"^ "** ^ meas ^ d slant 
and a prediction of the nevZlmZL^T ^ ^ eStimate ° f state 13 *> 

e^ntdtal^ "' heart of me constrained 

the two estimates of state in Lco^nc ^ wfm S an ° fi wSf " % filter *«^s 
input the two estimates of state the vessel' ^^T^ , ^ ^ module as 

state estimate therefrom. subsystem and computes the linear filter's 

After the prediction and observation steos of rhp ^ 

estimates of the system observer mTt to me V~ d S ^ c ° m P^d. the position 
merged with the prediction of the^oc^nS'I terTain based observation <y) is 

innovations with the prediction via £ liCmeo^ ^ " * ^ 

1. In essence the innovations define tti -new £ V " ^ mfomati °n « ^e n- 

time step („). The innovations are compS mlaTof 5,^ * T' able at present 
separately. These 'innovations' can be ex^d a^ independent directions 



M Vn x *m-i (4.15) 



After the innovations are defined, they are memed^fhth „• - 

y are merged with the prediction in each direction 
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at for this system (extracted Kataan StaS ™ „ 5 1 , Kr gai " which Is heutisScallv 
Again teno^ag a. Kataaa Ws. Ss" e^^™ ^ ffl,B > 

nonlinear constraints have been added Uo toSf!h underwater vessels and this system 
errors in linearization and the l^V^syZmJ^ P erfoimanc - tTthT 
be construed. This is done in two stagls First * v. near fi]ter ' S out P» t 

state 1S thresholded. Secondly, the slanf ^Su^Tf fr ° m 1,16 P™*** 

the correct distance from the known poteTlta^S * eStim * ted loc ^on to be 

constrained part of the con^Z^nL^^l^T^^ m0dule foims *« 
nonhnear constraints module is shov^S RgS^ ^ a 8 Ml flow ^agram for the 

The non-linear constraint module T *i. 

^ge and location of the ^^S^^T? measured sl "« 

from the system observer subsystem and I me T' ' &nal predicted sta * 1560 

generates an estimate the vessel' s Tnal smte ! 5^9 ^ 1575 "* 

I^S^TJ^ * - of which are addled b y a 

from the system by means Of a Shdd £ ££SE^^ * CUU 0utIieis 
system is allowed to change the p^Sdto^^!^ 1 ^ ***** * at me 

• the observation 

by comparing the diffe reTe bXe^^^^ ™* * accomplished 

magnitude to a certain value. Boio^iStfS^S < ^ eCtl ° n and by Itoitfa « its 
the Kalman filter in each axis to e to piv Xtem SSg^""^ fr ° m 
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This may be expressed 



as: 



x n\n 



X n\n — 



X n\n~-1 " € 




"1* x n\n~l < 






when 




(4.19) 






^nfn ~ x nin~l > € 




*n|n-l — € 










when 




(4.20) 











meterspersecond. This is S T^^^^'^-^O.l 

S^JSSSS^^ This 
horizontal range CSS ^ ^ * to have *• comet 
aline starting loin t^X^^TS?^ ^ * ***** 
. This line is then scaled by nivi^tSeSSSii ^mated vessel position 
range is correct. This serves to fa£2U?2T^ P ° Slt, ° n ^ *° Une «ntfl the 
movements in position ^v^XeSSv " for ^ 

not realistic given the slant Sge^oSo^ * P"™ 1 * P ositi °™ that a£ 

oiher Kalman «*« - 

nonlinearities into the linear system m ^fl L ' ° f * e By introducing 

The output of this module comXeY^;! * T the real dynamics better 

locauon and is the best -li^^SS^ 1 *" -to me predict 
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£Mxi2 s^aar ^ «■ 1699 *- - ~ 

step 1698 using data *a£j^£^™^-' state at the next tin* 
P^CesS^ 

range from the at least one iiffirtto ^SSS^ 0 ? T^' and a measured slant ■ 
co m putesa fin ales tim ateof^^ . 

. Preparing one of the state estates for Se next 2ES£ ^ ta the S ^ e in 

™-o% p S^ 

throughout this Z?JT dileCti0a ™» *» done 

ponion of the unmeasured enSiS^S^Sf? " C ° mpUted * ■ 

differencing the previous two DoskL ^ direction. This is done by • • 

value of „ is different taiSS^'ST* "? """^^ the res <* by l-„. The 

for the correct value is 0.1 ^ f ° r each s P ecific s ^tem, but a ballpa^Hgure 

SSSSK^ « - - ^ step given an 

can be expressed for eack axis * * mcor P orate ""V unmeasured velocity which 

= ^ + (1 - - ^) 

determine the estimate of vessel ^^5? * 

input used by the state velocity IX^ The^ ^^ ° f vessel ve <°<*y ■ 
forward as one of the «^^^SSSSS^ h *" fed 

^^^^ 

analytically determSe tli^SS^^.~j;! er - ^ COn * uter is ^«d to 
slant range of the undan^^SK^^^™^ the bathvme ^ data, the 

«r venicie to the position marker, position and velocity of the 



(421) 
(4.22) 
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displayed on «= it her a 4teo monte o?a Sg S"" Mf0nm,t *"' m <* be 

modifications can bo ,S^dL,^f J "!? oth<! ' v ™«i°os and 

scop, and d* ^St^"^*' *» *e 
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